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1.0  INTRODUCTION 


This  effort  was  initiated  to  provide  an  opportunity  to 
become  familiar  with  strapdown  inertial  navigation  hardware 
and  the  software  necessary  for  alignment  and  navigation.  To 
that  end»  a  Honeywell  H-478  inertial  sensor  assembly  was  se¬ 
lected  for  experimentation.  The  H-478  ISA  is  a  simplified 
strapdown  inertial  system  which  is  small/  lightweight  and 
easy  to  use  and  maintain.  The  gyros  and  accelerometers 
mounted  in  the  H-478  ISA  sense  angular  rates  and  specific 
force  about  three  body  axes.  Each  output  is  digitized  to 
form  attitude  change  (delta  theta)  and  velocity  change 
(delta  vee)  pulses.  The  H-478  ISA  was  mounted  on  the  preci¬ 
sion  alignment  table  in  the  stationary  evaluation  laboratory 
(SEL)/  and  the  outputs  were  delivered  to  the  PDP  11/40  com¬ 
puter  for  processing  and  recording.  In  order  for  the  PDP 
11/40  to  receive  the  H-478  output  signals/  it  was  necessary 
to  provide  an  appropriate  interface  unit.  This  was  designed 
and  built  in  an  in-house  effort  which  represented  a  signifi¬ 
cant  portion  of  the  total  effort.  The  interface  is  a 
self-contained  unit  which  permits  the  monitoring  of  the 
H-478  signals  and  provides  centralized  power  requirements. 

The  gyro  and  accelerometer  outputs  from  the  H-478  ISA 
were  recorded  on  9-track  tape  and  supplied  as  inputs  to  al¬ 
ignment  and  navigation  computer  programs  hosted  on  the  Con- 
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trol  Data  Corporation  (CDC)  6600  computer. 

The  alignment  program  consisted  of  a  coarse  alignment 
phase  followed  by  a  three-state  Kalman  filter  which  executed 
the  fine  alignment.  Plots  of  alignment  attitude  -  heading, 
pitch,  and  roll  and  their  errors  -  were  obtained  as  func¬ 
tions  of  time. 

The  navigation  program  was  the  Draper  INSS  program, 
which  was  modified  to  accept  the  H-478  gyro  and  accelerome¬ 
ter  data  from  tape.  Based  on  these  inputs  and  the  orienta¬ 
tion  of  the  platform,  found  from  the  alignment  mode,  posi¬ 
tion,  velocity  and  attitude  were  computed  as  a  function  of 
time.  The  differences  between  computed  and  actual  values, 
i.e.  errors,  were  plotted  for  horizontal  position  and  velo- 
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2.  0  H-478  INTERFACE 

The  H-478  interface  is  a  sel f-contained/  multifunction 
unit  designed  to  collect  and  format  signals  from  the  H-478 
Inertial  Sensor  Assembly  <ISA)  for  use  on  the  PDP-11/40  mi¬ 
crocomputer.  The  interface  contains  its  own  power  supply 
and  cooling  systems.  Each  one  of  the  data  lines  from  the 
H-478  INS  can  be  monitored  by  use  of  front  panel  mounted 
test  points.  Frequencies  can  be  checked  by  an  attached 
counter. 

The  unit  was  designed  for  easy  troubleshooting  and  ma¬ 
intenance.  To  reduce  ground  loops/  all  circuitry  is  isolat¬ 
ed  from  ground  except  at  one  point/  and  each  chip  is  indivi¬ 
dually  connected  to  Vcc  and  Gnd.  The  unit  also  has  power 
control  functions  for  the  H-478. 

The  interface  circuitry  is  basically  made  up  of  three 
sections;  the  polarity  phasing  and  decode  logic*  the  con¬ 
trol/interrupt  controller#  and  the  data  storage/output  sec¬ 
tion. 

2. 1  Polarity  Phasing  and  Decode  Logic 

The  polarity  phasing  and  decode  logic  are  shown  in  Fig¬ 
ure  2-1.  The  ISA  gyro  and  accelerometer  output  voltages  are 


FIGURE  2.1  POLARITY  PHASING  AND  DECODE  LOGIC 
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fed  into  integrators  to  be  digitized  into  delta  theta  and 
delta  vee  output  pulses  Pulse  trains  are  provided  by 
trans i stor-trans i stoi — logic  (TTL)  compatible  differential 
line  drivers  which  are  polarity  encoded  with  reference  to  a 
common  12.8  KHz  square  wave  decode  signal 
d i ode-transi stor-1 og ic  (DDT).  The  output  of  the  ISA  are  HI 
and  LO  and  pulses  and  a  HI  and  LO  digital  decode 
reference  signal  (DDT).  The  polarities  are  determined  by 
encoding  the  and  signals  with  the  DTL  pulse.  The  HI 
and  LD  refer  to  the  fact  that  the  signals  are  from  differen¬ 
tial  amplifiersi  providing  both  a  positive  and  a  negative 
signal. 

The  polarity  phasing  and  decode  logic  section  is  made 
up  of  DS8820A  dual  line  receivers  and  74LS00  dual  input  NAND 
gates.  The  output  is  a  pair  of  TTL  compatible  data  signals* 
one  for  "positive"  pulses*  and  one  for  "negative"  pulses. 
These  are  then  fed  to  the  data  storage  and  output  section. 

2.2  Control/Interrupt  Controller 

The  control/interrupt  controller  is  shown  in  Figure 
2-2.  The  term  "data  cycle"*  as  used  in  this  explanation* 
indicates  the  transfer  of  data  from  the  interface  into  com¬ 
puter  memory.  The  number  of  data  cycles  per  second  is  de¬ 
termined  by  the  computer  program  and  can  be  changed  The 
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H-478  puts  out  an  800  Hz  B  clock  pulse  that  is  used  in 
determining  the  number  of  data  cycles  per  second. 

the  interrupt  controller  consists  of  a  counter  preset 
circuit  and  an  8-bit  count-up  binary  counter.  The  counter 
preset  circuit  uses  two  74LS175  D-type  flip-flops  and  a 
74LS08  dual  input  AND  gate.  Since  the  information  at  the  D 
input  of  the  flip-flop  can  only  be  transferred  to  the  G  out¬ 
puts  on  the  positive  going  edge  of  the  load  signal  (NDRDY). 
the  flip-flops  act  as  a  binary  storage  unit.  With  only  two 
74LS175's.  the  maximum  number  that  can  be  stored  is  a  binary 
255.  Both  inputs  to  the  AND  gate.  NDRDY  and  COUT.  are  noi — 
mally  high.  The  counter  circuitry  uses  two  74LS193/s  cas¬ 
caded  to  form  an  8-bit  counter  that  can  be  preset  to  a  cer¬ 
tain  value.  The  800  Hz  clock  is  connected  to  the  count-up 
input.  The  maximum  number  that  can  be  counted  is  a  binary 
255 


To  get.  for  example,  four  data  cycles  per  second.  the 
counter  must  be  preset  with  a  value  so  that  with  every  200 
cycles  of  the  B  clock,  the  counter  will  produce  a  pulse 
that  will  shift  data  out  of  the  interface.  This  means  that 
the  counter  preset  must  be  loaded,  in  this  case,  with  a  bi¬ 
nary  56.  the  counter  preset  value.  This  value  is  shifted  to 
the  Q  outputs  of  the  74LS175'5  on  the  positive  going  edge  of 
the  NDRDY  pulse  (DRDY  is  normally  high,  therefore  the  load 
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signal  is  a  negative  going  pulse)  This  negative  going 
pulse  causes  the  output  of  the  AND  gate/  DRDY,  to  go  loin. 
The  DRDY  is  connected  to  the  load  input  of  the  counter. 
This  loads  or  presets  the  counter  to  the  preset  value/  the 
binary  56.  With  every  200  cycles  (of  the  800  Hz  B  clock) 
an  output  pulse  is  produced.  This  pulse/  COUT/  goes  to  the 
control  section  and  also  to  the  AND  gate  in  the  counter  pre¬ 
set  circuit.  This  drives  the  output/  DRDY/  low,  which  again 
loads  the  counter  with  the  preset  value.  The  computer  only 
needs  to  load  the  preset  value  one  time/  or  when  it  needs  to 
be  changed. 

The  control  circuit  consists  of  four  chips;  a  7474/  a 
74123.  a  74LS138,  and  a  74LS193.  The  COUT  pulse  provides 
control  for  three  functions  in  the  control  circuit  and  in 
the  data  storage/output  section.  The  pulse  is  inverted  to 
drive  the  enable  of  the  octal  D-type  latch.  in  the  output 
section.  low.  This  latches  the  data  in  the  storage  section 
to  the  output  section.  At  the  same  time.  COUT  is  applied  to 
the  74LS123  and  to  the  7474  The  Q  output  of  the  74LS123.  a 
retr iggerable  mono-stable  multivibrator,  is  inverted  and  ap¬ 
plied  to  the  clear  input  of  the  74LS193s  m  the  data  storage 
section.  This  clears  the  counters  after  the  data  has  been 
transferred  into  the  output  section.  The  G  output  of  the 
7474.  a  D-type  flip-flop,  referred  to  as  REGA.  is  used  to 
signal  the  computer  that  data  is  ready  to  transmit.  The 
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computer  responds  with  the  DRTAN  signal,  which  is  a  pulse 
train  of  seven  bits.  This  is  applied  to  the  74LS123.  The 
output,  which  is  a  binary  count,  is  connected  to  the 
74LS138,  a  three  to  eight  line  decoder.  This  output,  DATA 
SELECT,  is  applied  to  the  output  control  on  the  74LS373s,  in 
the  output  section,  in  turn.  This  transfers  the  latched 
data  to  the  data  output  bus.  The  DTRAN  also  resets  the 
7474.  Another  clear  pulse,  out  of  the  74LS123,  clears  the 
DTRAN  counter.  This  insures  that  the  counter  will  begin 
counting  with  zero  at  the  start  of  each  data  cycle. 

2.3  Data  Storage/Output  Section 

The  data  storage/output  section  is  shown  in  Figure  2-3. 
This  section  Is  made  up  of  74LSI93  and  74LS373  chips.  The 
function  of  this  section  has  already  been  explained  except 
for  the  record  count  <RCD),  which  simply  counts  the  number 
of  data  cycles  transmitted.  The  count  is  incremented  by  the 
fifth  data  select  pulse.  Since  the  computer  reads  sixteen 
bits  and  only  eight  bits  are  provided  by  the  record  count 
circuit,  a  74LS244  has  been  added  to  ensure  that  the  last 
eight  bits  are  zeros.  The  record  count  also  serves  as  a 
fault  indicator  If  for  some  reason  there  is  a  malfunction 
of  the  data  transmit  signal,  the  record  count  will  not  in¬ 


crement. 
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3. 0  DATA  PREPARATION 


In  order  to  facilitate  the  use  of  the  ISA  data  output 
for  alignment  and  navigation,  it  uas  necessary  to  (1)  per¬ 
form  pre-averag ing  and  <2>  compute  the  sensor  biases.  These 
steps  are  described  below. 


3.  1  Data  Averaging 


Figures  3-1  and  3-2  are  functional  schematic  diagrams 
showing  the  numerical  operation  of  the  gyros  and  accelerome¬ 
ters.  Both  operate  on  the  pendulum  rebalance  principle  and 
produce  pulse  outputs  proportional  to  the  integral  of  angu¬ 
lar  velocity  for  the  gyros  and  the  integral  of  specific 
force  for  the  accelerometers. 


3.  1 .  1  Gyros 


If  Fkis  the  number  of  gyro  pulses  counted  in  time  T, 


Pe 


<3-1  ) 


where  n  is  the  number  of  pulses  per  readout  interval,  then 
the  average  angular  velocity  referred  to  the  input  is 


FIGURE  3-1  GYRO  FUNCTIONAL  SCHEMATIC 
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FIGURE  3-2  ACCELEROMETER  FUNCTIONAL  SCHEMATIC 
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li  =  (3-2) 

where  is  the  pulse  weighting. 

The  H-478  gyro  channels/  as  obtained  from  Honeywell# 
had  a  pulse  weighting  of  k^  =  62.  sec /pul se.  Considering#  as 
we  do  for  these  experiments#  earth  rate  to  be  the  only  angu¬ 
lar  velocity  impingent  upon  the  system#  it  is  found  that  a 
pulse  occurs  roughly  only  once  every  5  seconds  on  the  north 
level  axis.  In  order  to  compensate  for  this  lack  of  sensi¬ 
tivity#  the  time  interval  T  used  in  the  above  relationship 
was  5  minutes  (300  seconds). 

A  more  direct  approach  to  increasing  the  sensitivity 
was  that  of  reducing  the  pulse  weighting  factor  k^#  thereby 
letting  each  pulse  represent  less  angular  rotation.  This 
was  accomplished  by  raising  the  amplifier  gain#  hence  allow¬ 
ing  the  integral  of  w(t)«  Figure  3-2#  to  reach  the  fixed 
threshold  level  more  frequently  for  a  given  w(t)  input.  For 
this  purpose#  the  gain  was  multiplied  by  10#  giving  k^»  =  6.2 

sec/pulse  for  certain  of  the  runs  described  below. 

3.  1.  2  Accelerometer 

As  can  be  seen  by  comparing  Figures  3-1  and  3-2#  from  a 
functional  viewpoint#  the  accelerometer  and  gyros  are  com- 
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pletely  analogous  In  this  case,  the  average  specific  force 
referred  to  the  input  is 


where  P^  is  the  total  pulse  count  in  time  T.  i.e. 

PA  =^Tn<t> 

and  k^is  the  integral  of  specific  force  per  pulse.  For  the 
H-478.  kA=  .0625  ft/sec/pulse. 

3.  2  Bias  Determination 

In  general>  gyro  and  accelerometer  biases  were  made  by 
leveling  the  sensor  triad  and  computing  the  difference 
between  measured  and  computed  outputs  along  or  about  the 
sensor  forward!  right  wing  and  down  (X!y!z)  axes. 

3.  2.  1  Gyro  Bias 

The  north,  east  and  down  components  of  earth  rate  are 
w^  -  XlcosL 

w -  —  O  (3-3) 

Wp  =  -ilsinL 
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where  is  polar  earth  rate  and  L  is  geographic  latitude. 

The  biases  for  the  forward  and  right  wing  gyros  are  ob¬ 
tained  with  the  given  axis  pointed  north.  This  is  done  to 
minimize  the  effect  of  not  knowing*  precisely*  the  east  or 
north  directions.  Thus  if  there  is  an  azimuthal  error  * 
the  sensed  component  of  earth  rate  about  the  axis  for  which 
the  bias  is  sought  will  be  (see  equation  3-3) 

w^  =  -O.cosl_cos£  (3-4) 

If,  for  example*  lei  is  as  large  as  2° *  the  measured  result 
will  be  diminished  by  only  «061X.  Hence  a  fair  degree  of 
uncertainty  may  be  tolerated  in  pointing  a  given  axis  north 
for  this  purpose. 

Because  of  the  above*  the  x  and  y  gyro  axes  are  placed 
in  the  local  level  plane.  The  bias  on  the  x  (forward)  gyro 
is  determined  by  pointing  the  x-axis  north  and  calculating 

£wg  -  — «Hc  osL.  (3-5) 


where  the  processed  measurement  Wjfis  given  by  equation  3-2. 
The  bias  on  the  y-axis  (right  wing)  gyro  may  be  obtained  by 
pointing  it  north  giving 
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%  =  3  -ilcosL 

3  0 


or  pointing  the  left  wing  north  (forward  east)  giving 


%  ”  w  +^icusL 

«  & 


The  z-axis  gyro  bias  (vertical  and  down)  is  given  as 


S  w^  =  w^+^2cos  L 


3.  2.  2  Accelerometer  Bias 


Che  north  east  and  down  components  of  gravity  are 


fH  *  0 

fe  =  0 

fD  "  "9 

Hence,  with  the  x  and  y  accelerometers  level  and  z  down 
biases  are  given  by 


-  *% 

=  f^ 

«Sf„  =  f  i  +32.  15479528 


(3-6) 


(3-7) 


(3-8) 


.  the 
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3.3  Data  Averaging  and  Bias-Summary 

A  summary  of  the  computations  required  for  data  prepar¬ 
ation  as  discussed  above  is  presented  beloui. 

3.  3.  1  Moving  Averages 


( a )  ACCELEROMETER,  x,  y,  z 


where:  k^  =  0625  < ft/sec ) /pu 1 se 

=  number  of  ac c e 1 er ometer  pulses  in  time  T 
T  ^  5  min. 


(b  ) 


GYRO,  x,  y,  z 


w 


kP 

-TP« 


where:  k^  = 
P<3  = 


T  - 


.0003,  .00003  rad/pulse 
number  of  gyro  pulses  in  time 
5  min. 


T 


3.3.2  Bias  Determination 

(a)  COMPUTING  X  GYRO  BIAS 
x-axis  is  pointed  north 
5w^  -  w^-.Q.cos  L 

(b)  COMPUTING  ALL  OTHER  BIASES 


x-axis  pointed  east 
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u^+iisin 


f 


X 


L 


5f,  “  V 

5>  ‘  V9 

.0000729115147  rad/sec 


39.  783333  deg 

a» 


32.  15479528  ft/sec 
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4. 0  A1 ignment 


The  alignment  of  a  strapdown  inertial  guidance  assembly 
consists  in  determining  the  transf ormat i on  from  platform 
coordinates  to  local-level  navigation  coordinates.  This  is 
accomplished  in  two  steps;  (1)  a  coarse  or  analytic  align¬ 
ment.  and  (2)  a  fine  alignment.  These  are  described  in  the 
following  paragraphs. 


4.  1  Coarse  Alignment 


Coarse  alignment  yields  an  initial  value  for  the  navi- 

k> 

gation  to  platform  direction  cosine  matrix  C^  .  ignoring  any 
effects  from  biases  or  noise.  It  is  a  purely  analytic  meth¬ 
od  which  uses  the  gravity  and  earth  rate  vectors  and  their 

resultant  outputs  to  deterministically  solve  for  an  approxi- 

to 

mation  to  C*,  Let  f4‘  and  w/  (j  =  1.  2.  3)  represent  the 

n  3  3 

accelerometer  and  gyro  outputs  respectively.  If  we  form  the 
unit  vectors 


Fi  *  V'1' 

wi  * 


<4-1  ) 


the  elements  of  the  DCM  are  uniquely  determined  as 


/cosL 
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where 


Cgz.  ~  -F^’sinL) /cosL 

CP  “F» 


z. 

Z 

z3 


-  Fd  -F^  W3 
%  =  F,  W3  -F3  W, 


=  W,  -F,  W^. 


(4-2) 


(4-3) 


In  the  above>  it  is  assumed  that  navigation  coordinates  are 
given  as  east-north-up.  The  platform  coordinates  may  be  de¬ 
signated  arbitrarily.  Appendix  A  gives  a  detailed  deriva¬ 
tion  of  the  coarse  alignment  equations.  These  are  the  ex¬ 
pressions  used  for  coarse  alignment  with  the  H-478  sensor 
data. 


4.2  Fine  Alignment 

The  Kalman  filter  technique  is  employed  to  arrive  at  a 

final  value  for  the  navigation  to  platform  direction  cosine 

|> 

matrix  C^,  #  The  detailed  development  of  the  required  equa¬ 
tions  is  given  in  Appendix  B.  Since  the  sensor  assembly  is 
mounted  on  the  Software  Evaluation  Laboratory  (SEL)  align¬ 
ment  table>  which  remains  stationary  with  respect  to  the 
earth*  the  problem  is  considered  to  have  no  dynamics. 
Hence,  only  the  measurement  update  expression  for  the  filter 


PAGE  23 


I 


is  addressed.  The  filter  states  are  taken  to  be  the  three 


angular  errors  in  the  estimate  of  the  navigation  to 


i  x  C?  . 


platform  direction  cosine  matrix  •  An  updated  estimate 
of  (J  time  k  is  given  in  terms  of  its  previous  estimate 
at  time  k-1  as 


cj  <  k-1 ) 


(4-4) 


where  is  the  most  recent  estimate  of  the  state  vector. 

9 

The  current  estimate  of  the  state  vector  is  given  by 


A 

M,<k>  =  ♦  KZ 


Rfcb 


(4-5) 


where  K  is  the  matrix  of  optimum  Kalman  gains  and  ,Z g£$ar e 
the  measurement  residuals. 


The  three  accelerometer  and  three  gyro  measurements  Z 
are  related  to  the  imput  specific  force  and  angular  velocity 
as 


<«-6> 

where  v  is  a  vector  of  white  noises  inherent  in  the  sensors* 
and  H  is  the  6x3  matrix  given  as 


(4-7) 


At  any  given  time  the  estimated  or  predicted  value  of  £  is 
given  as 


A 

Z 


ci  tn 

4?  !»• 


(f 


The  measurement  residual  of  equation  (4-5) 


■ZE$ 


A 

I  -  1 


(4-8) 


is  thus  given  by 

(4-9) 


The  3x3  Kalman  gain  matrix  K  is  given  at  the  kth  instant  of 
time  as 


*  -  Hfe  «Hfc  >''  <♦"«» 

where  P  is  the  covariance  matrix  of  the  state  vector  esti¬ 
mates  prior  to  the  kth  measurement  update,  and  R  is  the  6x6 
covariance  matrix  of  gyro  and  accelerometer  measurements. 
The  covariance  matrix  of  the  state  vector  estimates  after 
the  kth  measurement  update  is  given  by 

P £  -  (I-KHfc)P^  (4-11) 


The  filter  was  implemented  using  Carlson's  triangular  formu¬ 
lation.  This  method  incorporates  the  measurements  sequen- 
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tially,  thereby  yielding  an  updated  state  vector  and  covari¬ 
ance  matrix  after  each  measurement. 
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! 


i 


1 


I 


5.  0  NAVIGATION 


The  navigation  software  used  with  H-478  data  was  devel¬ 
oped  by  the  Draper  Laboratory  under  contract  to  the  Air 
Force  Avionics  Laboratory  E1D.  The  Inertial  Navigation 
Strapdown  Simulator  (INSS)  program  was  developed  as  a  tool 
for  evaluating  the  effects  of  a  tactical  aircraft  environ¬ 
ment  on  the  performance  of  the  inertial  components  in  a 
strapdown  aircraft  inertial  measurement  unit  and  hence*  on 
the  resulting  INS  navigation  and  attitude  performance. 

The  INSS  program  was  modified  to  accept  H-478  data  re¬ 
corded  on  nine-track  tape.  Since  this  data  was  the  output 
of  gyro  and  accelerometer  sensors.  the  portions  of  INSS 
which  simulate  inertial  sensors  were  bypassed.  The  naviga¬ 
tion  algorithms  use  an  alpha-wander  coordinate  system  and 
third  order  altitude  damping. 

Denoting  the  wander  azimuth  coordinate  system  by  the 
letter  w.  the  velocity  differential  equation  is 

v*'  «  cjj  £%aW  “(w,ivy+2g;^  )*vw  -C^Ahu^  -«j  u^  (5-1) 

where 

Ah  *  h-hjj 
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hg  =  barometric  altitude 
a  —  C^Ah 


C^_  *  2nd  order  altitude  damping  constant 

C3  =  3rd  order  altitude  damping  constant 

u 0  ~  (0  0  1 )  *  unit  vertical  vector 

-  h 

w^^  =  angular  rate  vector  of  wander  azimuth  wrt  earth 
coordinates 

w^  =  angular  rate  vector  of  earth  wrt  inertial 
coordinates 
q.  =  gravity  vector 

J9 

f  —  force  vector  from  the  accelerometers 

CW  =*  direction  cosine  matrix  transformation  from 

9 

platform  (or  body)  to  wander  azimuth 
coord inates 

<x)  =  the  skew-symmetric  form  of  a  vector  x.. 


Figure  5-1  is  a  mathematical  flow  diagram  showing  the  navi¬ 
gation  computations.  The  initial  value  of  the  transforma¬ 


tion  of  CZ  is  found  by  the  alignment  procedure  previously 

H 


d i sc  ussed. 


This  transformation  is  seen  to  be  a  function  of 


the  gyro  output  vector  w* 


hr 


The  differential  equation  which  propagates  the  horizon¬ 
tal  position  is 


(5-2) 


INSS  NAVIGATION  MATHEMATICAL  FLOW  DIAGRAM 


where 
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the  angular  velocity  vector  of  the  wander 
azimuth  wrt  earth  coordinates  (craft  rate) 
the  direction  cosine  transformation  from 
earth  to  wander  azimuth  coordinates 


This  matrix  is  of  the  form*  Figure  5-2* 


cosLcos  cosLsin<X“  Xe* 


sinL 

cosLsinOC 


c  osLcosiX- 


where 


(5-3) 


L  =  geographic  latitude 
Xo  =  initial  longitude 
X  *  current  longitude 
*  wander  angle 


Horizontal  position  is  extracted  from  the  matrix#  equa¬ 

tion  5-3#  as 


*  arctan 


■  arctan 


c,vc;» 


(■&) 


(5-4) 
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Vertical  position,  i.  e.  altitude,  is  given  by  the  differen¬ 
tial  equation 


h  =  “  C ,  Ah 

where 

vj>  =  the  vertical  component  of  the  velocity 
vector  v,  equation  5-1 

C|  =  the  1st  order  altitude  damping  constant 


Also  obtainable  from  is  the  wander  angle 


(5-5) 


Oc  =  arc  tan 


(5-6) 


This  is  required  to  determine  attitude  as  is  shown  below. 


The  attitude  at  any  instant  may  be  extracted  from  the 
transformation  of  equation  5-1.  denoting  the  platform 
frame  as  Foreward-Leftwing-Up  and  the  navigation  frame  as 


Up-East-North  (whenOC=0>, 


s  inP 


s inRc  osP 


c  osRcosP 


cosPsin(H+  Oi. ) 
c  osPc  os  ( H+  iX  > 


(5-7) 
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6.0  EXPERIMENTAL  RESULTS 

In  order  to  exercise  the  H-478  and  the  associated 
software  described  above<  the  sensor  assembly  was  nominally 
oriented  as  shown  in  Figure  6-1.  The  experimental  problem, 
using  only  the  gyro  and  accelerometer  outputs,  is  to  (1)  de¬ 
termine  the  orientation  of  the  ISA  and  (2)  determine  posi¬ 
tion.  velocity  and  attitude  over  a  period  of  time  using  this 
stationary  trajectory. 

In  each  of  two  cases  the  three  accelerometer  and  three 
gyro  pulse  counts  were  recorded  onto  nine-track  high  density 
magnetic  tape.  At  the  outset,  for  each  case,  the  x  or  foi — 
ward  axis  was  pointed  to  the  north  in  order  to  obtain  the 
x-gyro  bias  as  explained  in  3.2.  1.  Approximately  one  hour 
is  spent  in  that  position.  The  x-axis  is  then  turned  east¬ 
ward  where  it  remains  for  the  rest  of  the  recording  period. 
In  this  position,  data  was  taken  for  approximately  one  hour 
on  run  number  one  and  approx ima te 1 y  two  hours  on  run  number 
two  From  this  data.  i.e.  with  x  eastward,  we  obtain  (1) 
bias  quantities  for  the  y  and  z  gyros  and  all  accelerome¬ 
ters,  (2)  estimates  of  each  sensor's  noise  variance,  <3)  al¬ 
ignment  and  (4)  navigation. 
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6. 1  Run  #  1 

This  run*  recorded  on  tape  X00540.  is  with  the  gyro 
scale  factors  unaltered)  62.  arcsec/pulse.  As  in  all 
cases,  the  pulse  data  is  averaged  over  5  minutes.  The  data 
interval  is  .25  seconds.  Consequently.  1200  data  points  are 
averaged  to  obtain  each  gyro  and  accelerometer  reading.  The 
biases  and  noise  standard  deviations  are  given  in  Table  6-1 
beloui. 


GYRO 

( RAD/SEC > 


NOISE 

DEV 


6.  0X10 


ACCEL 

(FT /SEC  *) 

!  BIAS 

NOISE 

DEV 

!  1.04X10 

1.  0X10 

!  6.48X10 

6.  0X10 

!  3.33X10 

1.  05X10 

Table  6-1  Measurements  for  X00540 

Figures  6-2  through  6-4  show  the  fine  alignment  process 
as  a  function  of  time  in  terms  of  heading,  pitch  and  roll  as 
determined  from  the  navigation  to  platform  coordinate  trans¬ 
formation. 


8 


ATTITUDE 


ATTITUDE 
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It  will  be  noted  that  the  pitch  and  roll  variations* 
Figures  6-3  and  6-4*  are  very  small*  less  than  one  thous¬ 
andth  of  a  degree.  Also*  the  uncertainty  associated  with 
roll  and  pitch  is  negligible. 

The  variations  in  heading  versus  time  are  more  pro¬ 
nounced  than  for  roll  or  pitch*  shouting  about  a  2°  /hr 
z-gyro  drift  from  1100  to  1500  seconds. 

The  attitude  used  for  alignment  in  the  navigation  mode 

was 


Head ing  91 .  25 

Pitch  -.000065 

Roll  .0002 


Figures  6-5 

through  6-8  show 

the  errors  in 

navigation. 

The 

latitude 

and  longitude 

plots  give 

approx imately 

a 

4  n.  m.  /hour 

position  error. 

The  velocity 

errors  grow 

to 

about  15  ft/sec  for  east  velocity  and  25  ft/sec  for  north 
velocity. 


0.0  400.0  1000.0  1400.0  2000.0  2500.0  3000.0  3400.0  4000.0 

TIME  ISSCJ 


FIGURE  6-5  NAVIGATION-LATITUDE  VS  TIME 


42 


c.o 


500.0 


I 


1000.0  1593.0  0000.0 

TIME  ICEC) 


3500.0 


3039.0 


3500.0 


5000.0 


FIGURE  6.6  NAVIGATION-LONGITUDE  VS  TIME 
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TIME  isEC) 


FIGURE  6- 


7  NAVIGATION-VELOCITY  EAST  VS  TIME 
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FIGURE  6.8  NAVIGATION-VELOCITY  NORTH  VS  TIME 
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6.  2  Run  «  2 

For  this  run*  the  gyro  scale  factor  uas  changed  to  6.2 
arc  sec/pulse.  Also,  the  recording  bias  lengthened  from  one 
to  two  hours  for  the  navigation  run.  Data  averaging  was  the 
same  as  in  Run  #  1.  Table  6-2  gives  the  measured  biases  and 
noise  standard  deviations  obtained  from  this  run. 


1 

1 

1 

1 

GYRO 

(RAD/SEC) 

1 

!  ACCEL 

!  (FT/SEC 

i 

> 

1 

1 

1 

1 

1 

1 

AXIS  ! 

| 

BIAS  ! 

NOISE 

i 

!  BIAS 

i 

i 

NOISE 

1 

1 

1 

l_ 

j 

i 

DEV 

1 

1 

i 

i 

DEV 

1 

1 

1 

1 

1 

X  ! 

i 

8.75X10  ! 

i 

3.  5X15 

1 

!  1.0X10 

1 

i 

i 

i 

1.  0X10 

1 

J 

1 

1 

1 

1 

Y  ! 

i 

2.  58X10  ! 

i 

1.  0X10 

1 

!  -2.75X10 

i 

i 

» 

* 

1.  0X10 

1 

1 

1 

1 

1 

1 

Z  ! 

i 

-2.  10X10  ! 

i 

3.  5X10 

i 

!  0.  0 
i 

• 

i 

• 

5.  0X10 

1 

1 

1 

Table  6-2  Measurements  for  X00097 

The  variation  in  heading.  Figure  6-9.  indicates  a  z-gyro 
drift  of  about  1°  /hr.  As  in  Run  #  1.  the  alignment  shows 


negligible  pitch  and  roll.  Figures  6-10  and  6-il. 


iv  id*  trwuio  osu/sjh*  '  bakOT'OT  wi  'tt  k  nu  »tr» 


PLOT  2 


H478  RLIGNMENT  RTTITUDE 
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The  attitude  used  for  alignment  in  the  navigation  mode 

was 


Heading 

89.  8 

Pitch 

.  001 

Roll 

.  0027 

Note  that  there  is  approximately  a  1.5  difference  in  head¬ 
ing  between  the  two  runs. 

The  Schuler  oscillation  (84  minutes  *  5040  seconds)  can 
be  seen  in  the  navigation  error  plots>  Figures  6-12  through 
6-15.  These  are  typical  of  the  plots  obtained  when  an  ini¬ 
tial  attitude  error  exists.  The  latitude  error  is 
50.  n.  m.  /hr.  The  maximum  velocity  errors  are  18.  ft/sec  and 
150.  ft/sec  for  the  east  and  north  directions  respectively. 


I 
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FIGURE  6-15  NAVIGATION-VELOCITY  NORTH  VS  TIME 


7000.0 


1 


54 


PAGE  56 


APPENDIX  A 


Equations  For  Strapdoum  Coarse  Alignment 


The  direction  cosine  matrix  relating  navigation  to 
platform  coordinates*  *  is  formed  by  using  the  relation¬ 
ships 


=  C*  f* 

<1  ~ 

-  cJ  k" 

=  CJ<fV> 


uihere 


f  is  the  specific  force  vector  and 
yj  is  the  angular  velocity  vector  of  the  platform 
uirt  inertial  space. 


In  equations  (1)*  f.*1  and  /are  inputs  to  the  accelerometers 
and  gyros  respectively*  while  f^  and  yd*  are  the  correspond¬ 
ing  outputs.  Equations  (1)  can  be  expressed  in  one  equation 


<fxwn )? 
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where  j  =  1.2.3  and  is  the  jkth  element  of  the  DCM.  * 
Equation  (2)  may  be  solved  explicitly  for  the  DCM  elements, 
thus 


c6‘  ^ 

1 f" 

* 

v**l 

\<i^  >, 

(  f.X  W  >z  (  f  xw 

(3) 


Now  the  input  vetors.  f  and  w  in  east-nor th-up  navigation 
coordinates  and  for  a  stationary  system  are  given  as 


*  < 


y*  =  ( 


0  0  g  ) 

0  -flcosL  i2sinL>T 


(4) 


where  g  is  gravity.  iXis  earth  rate  and  L  is  geographic  la¬ 
titude.  As  a  result  of  (4).  the  vector  f.**  xw^is  given  by 


£*  xyj'1  =  (-g.fl.cosL 


0) 


(5) 


(4)  and  (5) 

in  (3).  we  have 

/S‘\ 

\  0  0 

9  \ 

-1 

I* n 

ci*  fc 

0  -i^cosL 

1 

u2s inL 

wf' 

1  t 

1 

i-g  cosL  0 

0  ) 

} 

{•v 

(6) 


Inverting  the  matrix  in  (6)  gives 


\ 


I 


M 

1 0 

0  -1  l 

gflcosL 

c:* 

~ 

-sinL 

1  0 

gcosL 

•flcosL 

Wi 

‘4 

0  0 

/* 


4 


1 


We  note  at  this  point  that 


C*  I-. m” 


.r  j» 

-  f  X 


J 


Now  multiplying  out  equation  (7)  yields 


Cii 


ci » 


-2* 


g  cosL 

/  -« 


(4  -  ^)/- 


> 


inhere  from  (8)  is  calculated  using  the  instrument 


as 


i f  =  f  ?  w$  w£ 

wf  w3 


2S 


I  3-  2.  I 
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(7) 


(8) 


(9) 


outputs 


(10) 


We  can  effect  a  simplification  in  (9)  by  noting  that 
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If.  I  =  9 

juj  =  XI-  (11) 


Hence  equations  (9)  can  be  expressed  in  terms  of  unit  vec¬ 
tors.  Thus  if  ue  define  unit  vectors  in  the  platform  frame 


then 

*  / 

cv  *  ~V  'cos  L 

c^i  “  <WJ  sinL)  /cosL 

ci*  *  i 

where 


(12) 


(13) 


( 14) 


We  see  that  it  is  unnecessary  to  supply  explicit  numerical 
values  for  g  and  J2.*  Writing  out  the  matrix  explicitly.  we 
have  in  terms  of  the  unit  vectors,  (equation  (12)>» 


So  c 
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(F3 

Wj-  -Fz 

"s 

) /cosL 

<W*  -F, 

sinL) /cosL 

F,  ^ 

<r, 

W*  -F3 

Wi 

) /cosL 

( W  z  -Fz 

sinL)/cosL 

F* 

(15) 

Wz. 

W,  -F, 

WZ- 

)/cosL 

(W^  -F* 

s inL ) /c  osL 

F:J 
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APPENDIX  B 


Equation*  for  Strapdown  Fin*  Alignment 
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APPENDIX  B 


Equations  for  Strapdown  Fine  Alignment 


The  six  measurements  used  for  alignments  three  from  the 
accelerometers  and  three  from  the  gyros,  may  be  expressed  as 


P  A 
C°  f 
n  ~ 


f  A 

c«  “£j 


where 

accelerometer  outputs  in  platform  coordinates 

*  gyro  outputs  in  platform  coordinates 

direction  cosine  matrix  which  transforms  vectors 
from  east-north-up  navigation  coordinates  to 
forward-leftwing-up  platform  coordinates 

v7*  gaussian  white  measurement  noise  vector  with 
with  covaraince  matrix  R 

The  inputs  to  the  accelerometers  and  gyros*  £*and 
wl?  respectively*  are  given  as 


<  0  _ft,cosL  jlsinL)1 


where  g  is  gravity*  IX,  is  earth  rate  and  L  is  the  geographic 


latitude. 


Expanding  the  measurement  vector  i  about  current  indi- 
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cated  values.  i1  .  to  first  order  yield* 


( ' 

1 

fat*  \ 

l*i\ 

*  L  ~  L~ 

f 

+ 

1 

1 

eft*1:  j 
i  *  yJ 

where  v  end  ere  gaussian  white  measurement  noise  vectors 
essocieted  with  the  accelerometers  end  gyros  respectively. 
To  first  order 


(4) 


where  is  «  vector  of  platform  tilt  errors  with  respect 

to  the  nevigetion  frame.  Therefore*  equation  (3>  mey  be 
written  es 

hh  -  L  -  Lm  Hj.  +  xft  (5) 

where  the  stete  vector 

JL  ■  <6> 

end  the  meesurement  matrix 
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F  * 

<T (f x) 
I  ~ 


cNV> 


In  <5 )*  the  six  dimensional  noise  vector 


**  . 


Cf  *“♦  y‘> 
S*  T  V  , 


cj  ^  +  v«* 

*  -uft 


is  composed  of  sensor  noise  v^  and  v^plus  the  uncertainty 
associated  with  the  inputs  f*  and  w*?  »  equations  (2),  ex- 
pressed  in  platform  coordinates. 


In  general>  the  propagation  of  the  state  vector  £.  over 
time  is  given  as 

V-fci  + 

where  4^  is  a  known  3x3  transition  matrix  between  t^  and  t^, 
and  tt^is  a  random  disturbance  vector.  In  the  present  appli¬ 
cation*  2  and  4‘^is  the  identity  matrix.  Hence  there  is 

no  loss  of  information  between  measurement  updates.  After  a 
measurement  update*  the  covariance  of  &  is  given  as 


(I  -  KHi>P 


(10) 
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where  P  it  the  covariance  prior  to  tho  meaturement.  and  K  it 
tho  Kalman  gain  matrix/  given  at 

K  '  pAH*<HfcpfeH^*kr'  “»> 

Tho  ttato  voctor  will  bo  updated  in  accordance  with 

Lh.m  Lk-i*  *****  <l2> 

whore  the  meaturement  retidual 

<*3> 

and  K  it  the  optimal  Kalman  gain  matrix.  Since,  from  (9) 

$L  -  L  -  l1 

then  the  meaturement  retidual  it  formed  at 

I  A  T 

*BCS  "  i  "  i  -  <1  "  i.X> 
or 

<14> 

The  predicted  meaturement  value,  x.  in  (14)  it  obtained  bg 
u ting  (1).  Thut 
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1 


i 


\ 


(15) 


where  i *  the  updated  value  of  the  alignment  matrix  given 

in  terms  of  the  updated  state  variable*  _x  *^^,1  as 

sr'SeV’1-  ■  •  ] 

-  Sj(k-l).Kp[-(J<g^«l]  <16> 


In  order  to  effect  a  measurement  update*  it  is  necessary  to 
provide  the  covariance  of  the  noise  expressed  in  equation 
(8).  To  obtain  this  requires  evaluating  the  6x6  matrix 


v^and  x£are  given 


Is  aa 


_ a.  . 


and 


*'<?-  <=&£’♦  4 


(17) 


(18) 


(19) 


We  assume  here  that  during  alignment  the  platform  will  be 
maintained  nearly  vertical  and  that  platform  forward  will  be 
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approximately  pointed  to  the  north*  oast*  south  or  most. 


Considering  first  equation  (15>*  we  obtain 


(20) 


where  E 

i.  e. 


(«TJ 


is  the  covariance  of  the  accelerometer  noise* 


/« 

o 

o 


\ 


o 

0 

««3/ 


(21) 


using 


where 


then 


where 


P*  "  "  ~*o\}  + 


005279s in 


■L-S^l 


■ReJ 


g6“  sea  level  gravity 
L  ■  geographic  latitude 
h  ■  altitude 

Re  "  equatorial  earth  radians 
5  f ^  ■  -a,  $  s  +  a2Sh  * 
a,  -  • 005279  (•ft)  sin2L 


•  x  -  1  «■  « 05279s in* L-  4^ 


(22) 


(23) 

(24) 

(25) 
(261 


£s  =  north-south  location  arror  (»R€dL) (feet) 
$h  *  altitude  error  (feet) 

$9ass  error  in  gravity  (ft/sec1) 

Using  equation  (23)#  the  first  term  in  equation  (20) 

c'Ete<K  ■ 

The  first  three  (diagonal)  elements  of  (17)  become 


R  ( 1 ) 
R  (2) 
R(3) 


z 


-  % 
■  «t\ 


In  a  similar  fashiont  for  the  gyros  we  have 


is  the  covariance  of  the  gyro  instrument  noise. 


becomes 

(27) 


(2B) 


(29) 


(30) 


From  equation  (2)  we  have 
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5‘* 


-  <  O 


-(fcK  M 


coiL)  S* 


<31 ) 


Calculating  C^e|  c>  u*in9  **»•  Pi*«v*ously  noted  as¬ 
sumption*  and  combining  with  (30)  gives  the  remaining  diago¬ 
nal  elements  of  the  measurement  matrix 


R<4>  - 

R<9)  ■  C/t  ♦  ajj-j.  (32) 

R(6)  -  <S£} 

where 


(33) 


